Concerning the path non-optimization and the delay due to mutual-waiting caused by information island in the team travel, a collaborative path optimization algorithm was proposed which employed centralized computing based on information sharing among team members. The algorithm calculated the optimum navigation path weighted by the factor of meeting priority, taking meeting convenience and path/time shortening into overall consideration. Theoretical analysis shows that the computation complexity increases linearly with the number of team members, and is approximately equal to that of the traditional path optimization algorithm. The simulation results show that the factor of meeting priority has a great influence on optimization path and meeting place. So, the factor of meeting priority needs to be set according to the actual requirement to ensure the dynamic balance between team cooperation and shortening path. A typical application solution of collaborative path optimization algorithm was given to illustrate how to support and to help each other among team members, and to travel together to the destination in order, safely and quickly.